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Abstract 

The inverse kinematics solution, a modal position control algorithm, and path Pj^mng results 
for a 7 degree of freedom manipulator are presented. The redundant arm consists 
with “shoulder” and “elbow” joints and a spherical wrist. The mverse kinematics problem 
tip position is solved and the redundant joint is identified. It is also shown that a locus o P 

positions exists in which there are kinematic limitations on self-motion. A computationally simp e 
modal position control algorithm has been developed which guarantees a nearly co " s ^ dosed- 
loop dynamic response throughout the workspace. If all closed-loop poles are assigned to the same 
location, the algorithm can be implemented with very little computation. To fur her redu e the 
required computation, the modal gains are updated only at discrete time intervals Cr ^a^ 
developed for the frequency of these updates. For commanding manipulator movements, a 5th-order 
spline which minimizes jerk provides a smooth tip-space path. Schemes for deriving a corresponding 
joint-space trajectory are discussed. Modifying the trajectory to avoid joint torque saturation when 
a tip payload is added is also considered. Simulation results are presented. 

Introduction 

Configuring and designing robotic systems for space applications involve many considerations not 
present in terrestrial systems. Safety and versatility are of prime importance. For example, safety 
concerns create a need for obstacle avoidance algorithms. Versatility demands may necessitate 
the manipulator’s ability to perambulate between locations. Redundant manipulators meet these 
requirements because the additional degree(s) of freedom allow inclusion of obstacle avoidance 
algorithms and increase the maneuverability of the manipulator. The redundant joint configuration 
presently studied consists of two links with identical two degree-of-freedom shou der and elbow 
joints and a spherical wrist, making a total of 7 degrees of freedom. This particular joint geome ry 
has favorable characteristics with respect to singularity avoidance, obstacle avoidance, and simplicity. 
It is a candidate for use in several NASA applications on the Space Shuttle, Space Station, Polar 

Platform, and OMV. 

Since this paper deals with quantitative results for a representative space-based manipulator, it 
is necessarv to summarize the assumed system requirements. The fundamental task required us a 
pick-and- P iace motion involving a payload of mass up to 100 kg and tip forces of 100 N. Speed 
of operation is not deemed a high priority, so the manipulator has been designed to achieve tip 
velocities of 0.5 m/sec. The workspace should be roughly 4 m across, therefore the links are each 
1 0 m long. As a result, the joint must be capable of exerting 200 Nm of torque to meet the 1 
tip force requirement. Each link has a mass of 30 kg, including the associated joint. 
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Kinematics Analysis 

Figure i shows the manipulator configuration. The arm consists of two links of length L x and L 
connected by a two degree of freedom rotational joint (the “elbow”) The base link* k *ft 1 1 

fc loLTr <the »» -cation axis p.raM to 

" k n " • "? F, " P ™' JlC “ , “ to il Th„ shoulder roll axis is normal to the 

Ditch tlh f il V°,l n ^ e f ^ den ° ted 6u ° 2 ' and 6 < and called shoulder roll shoulder 
pitch, elbow roll, and elbow pitch, respectively. Joint angle limitations are not being considered 

The four degrees of freedom in the shoulder and elbow joints thus provide redundancy for positioning 
the mampulator tip A three dimensional wrist can then be used to orient the end effector Assuming 

in thil analysis ’ mat ' CS &re decou P led from ^ose of the rest of the arm and are not treated 



Figure 1. Joint Configuration of Redundant Manipulator 


e forward kinematics of the arm are easily solved using a variety of methods. In the present 
analysis, homogeneous transformation matrices derived from the Denavit-Hartenberg parameters 
were multiplied together to produce the vector reaching from the base point to the tip [1] The 


X 

y 

z 

where cj denotes cos#i, etc. 
base. 


- L l c l s 2 + L 2 (cis 2 c 4 - S1S3S4 + cic 2 c 3 s 4 ) 

= LiSiS 2 + L 2 (s 1 s 2 c 4 +CiS 3 S 4 +SiC 2 C 3 S 4 ) (1) 

= £iC 2 + L 2 (c 2 c 4 — s 2 c 3 s 4 ) . 

The reachable workspace is a sphere of radius L x + L 2 centered at the 


Every redundant manipulator is capable of self-motion, that is, the tip can be fixed while the joint 
angles are varied. For the present manipulator, self-motion consists of “orbiting” the elbow joint 
in a circle, during orbiting all four joint angles must change. In particular, the elbow roll angle 
aries from 0 to 360 . It follows that for a given tip position, an inverse kinematics solution can 
be found for any elbow roll angle. The same cannot be said for the other three degrees of freedom 
therefore the elbow roll angle is the redundant joint. (For some tip positions, there exists a kinematic 
limitation on the elbow roll angle. This will be addressed later.) 


Specifying the tip position and elbow roll angle does not uniquely determine the other joint angles - 
ere are still four possible solutions. These solutions determine one of two possible positions of the 
elbow joint and one of two possible orientations of link 1 . For example, if the tip lies in the xy-plane 
(see Figure 1) then a point on the side of link 1 could “face” the z-axis or the xy-plane. Also the 
elbow joint may be above or below the xy-plane. 
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Figure 2 shows an inverse kinematics “tree” containing the equations for these ' foU ' 

hi step obtaining a solution is arbitrarily choos.ug the elbow , rol »^e, ^ T ^he elbo a 

r™o possible ^bow joint pStions. Once one of these two configurations is chosen, the 

appropriate branch of the tree is selected. The shoulder pitch angle, hb 

equation is found by manipulation of the forward kinematics equations. The sign ambiguity m 
:’uSn corresponds to link . facing “up” or “down”. This choree of srgn d.term.nes the final 
branch of the tree. The shoulder roll angle is now uniquely determined. 



For all solutions, 


0! = atan2[Bi + (a4s 2 + Cc 2 ) y, (Aaz + Cfz) * ~ 


A = L\ H" L2C 4 C — £>2$ 4C3 

B = —LiSiSi D = A 2 + C 2 — z 2 


Figure 2: The Four Inverse Kinematics Solutions 


It has been noted that for some tip positions, there is a kinematic limitation on self-motion, meaning 
that the elbow roll angle cannot take on an arbitrary value. Mathematically, this limitation can be 
derived* fromThT equation for *. If D, equal to A’ + C> - is less than zero, then no so lut on 
exists This occurs when A and C are both “small”. A is the length of the arm projected onto the 
vector parallel to link 1, so A decreases as the arm is folded onto itself. C is proportional to cos 3 , 
thus it decreases as 9 3 nears 90°. From this qualitative analysis two results may be concluded 1) 
When the arm is relatively far extended the elbow roll angle can take on any value and thus comple 
orbiting is possible, and 2) When the arm is folded towards itself the elbow r„U angle be near 

0” Both of these conclusions can be restated rrgorously. Assummg L, - L, - L * can be . sh 
that for tin positions lying outsrde of the volume defined by two spheres centered at s - ±L and 
als 7 . the elbow roll angle may take on any value. For tip posrtrons lying rns.de of th» 
volume, the elbow roll angle is constrained to 


|0 3 | < arccos ■ 


j : 2 - (L i -jL 2 ) 2 

Ll(l-y 2 ) 


( 2 ) 
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where 7 = {L\ + L\ - r 2 )f(2L\L 2 ). This range of angles is centered around 0 3 = 0. Figure 3 shows 
the regions of limited orbit capability. 



Figure 3: Regions of Limited Orbit Capability 


For maximum maneuverability, Figure 3 indicates that it is desirable to keep the workspace near 
the xp-plane. An interesting parallel exists between this workspace location and the dexterous 
“workspace” of the human arm. The human arm is kinematically similar to the manipulator if 
we visualize its “z” axis extending horizontally out the sides of the shoulder. Our arms are most 
dexterous in front of us, which is near our zy-plane and corresponds to the manipulator area of 
complete orbit capability. 

Controller Design and Analysis 

The controller design for a space-based manipulator is primarily driven by requirements to maintain 
a specified closed-loop bandwidth with a minimum of computational complexity. The bandwidth 
is specified to accurately follow commanded trajectories. Disturbance rejection and modeling 
error impacts will be discussed later. Computed torque controllers, which use feedforward, will 
provide good dynamic response throughout the workspace; however, their computational complexity 
may preclude their use in space applications. The modal control algorithm presented in this 
paper is designed to maintain a nearly constant closed-loop dynamic response with a minimum 
of computation. 

The equations of motion of any space manipulator take the form 

r c = M (0)0 + K(0, 0) + F(0, 0) - r,, (3) 

where r c is the joint control torque, 0 is a vector of joint angles, M is the mass matrix, and V is 
the nonlinear velocity-squared term of the dynamics, F is the friction terms, and is the joint 
disturbance torque arising from tip disturbance torques. For purposes of controller design, V and 
F can be viewed as a disturbance torques. Therefore, assuming the controller will have sufficient 
disturbance rejection and/or V and F are sufficiently small, the controller can be designed based on 
the approximate equations of motion given by 

r c = A/(©)0. (4) 

If constant gain colocated joint control is applied to a manipulator the dynamic response varies widely 
throughout the workspace. Equation 4 shows that for slow motions this variation is primarily caused 
by the changes in the mass matrix as a function of 0. (Physically, the apparent inertia at each joint 
changes with arm geometry.) 
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The modal control algorithm applies colocated joint tor, ues 

configuration in order to ensure a nearly constant M is always 

The feedback gains are computed from the mass matrix as f U diagonal and 

real positive definite and thus may be transformed such hat S Mb -U, 

5 T 5 P = / The simplified equations of motion (equation 4) then become 


S T MSij = S T r c , 


( 5 ) 


where r, = S 1- ©. The elements of r? are called the modal coordinates. Equation 5 may be rewritten 
88 Dtj = u, . (6) 

wjitSS TS'S* are 7 mod,, 

inertias, denoted A,. The modal control torque thus takes the form 

u,' = + Kr,itfi)y 

» n 1 j,' _ « x . ru . are the ith modal position and rate gains, respectively, which 

where I\ ? i = and A r ,i — 2 A,Cx t f j a f re auencv of u/** The modal 

r c = —Sit = -5 [I< P I<r] { ]\ = S 1 K p K r) [ S 0 {l} ’ (8) 

where I< p and K r are diagonal matrices containing the position and rate gains given in equation 
The control torque may be rewritten as 

( 9 ) 


f c = — {SK P S 7 


SKrS T ] { 1 } 


Since eigenvalues are preserved under a similarity transformatmm^he^fe^^^sch^e of^^uation ^9 

results in the same closed-loop poles that were aanPje workspa ce is assured for sufficiently slow 
As a result, a constant dynamic response throughout the workspace is assure 

manipulator motions. 

The choice of closed-loop fluency and 

judgments. The requirements arise from 7,77o7sMrba„ce rejection , positioning accuracy, tip 
The engineering judgements include ^ consi real stability and performance 

time ^ J-er, £ -£ musthe 


Reducing Control Computation 


^ 

Implementing the algorithm described ° v ® i t ano rre«a ^ e avoirleTbv^ a'stmp^restrictUm 

the , he placed at the same 

location. In this case, the position and rate gain matrices become 

( 10 ) 


A’p = Du‘ 

K r = 2D<w, 


where < and a- are the damping and frequency, respectively, of that one pole location. As a result 
equation 9 reduces to 


n , f ©1 

r c — — [ M us " 2A/(Jo, ! ] q j 


ID 
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,i,e mass ^ by * — • ^ 
following, it is only necessary that their f h ’ T '* unrealistic ‘ For trajectory 
adequate. ' X that thelr frequencies are sufficiently high and their damping is 

za^n unl^f^" Perf °, rmed j° dete rmine how often these updates need to take place. The minimum 

from it For [S nr" S °? “* matrix is chan 6 in S si "ce the gains are computed 

Ditch angles Th ? T , mani . pu ‘ ator - the mass mat "x is most sensitive to the shoulder and elbow 
p ch angles. The shoulder pitch angle changes the apparent inertia about the shoulder roll joint 
because i moves he entire manipulator either closer or farther from that jomt’s ax. Tlie dbow 

jits If, r the'TJl ' H ”, ° r , OUl “ d “T C , h “ geS the ipparent in " tia ab ”“‘ b »‘ h Mulder 
for . result, the gain update frequency should be set according to expected pitch ande rates 

no 1 glV t t" manipulator motl °n. 14 has been found from simulation that the gains should be updated 
no less than once every 5= of either pitch angle rotation. Such rotations change the terms in the 
inertia matrix by less than 10%, provided the arm is not fully extended. 

Tip-Space Stiffness and Contact Forces 

Of interest in the design of a position controller are the forces of contact generated when the 
ampu a or ip approaches a desired location and touches the environment These forces are 
important m determining how well a manipulator performs a given task and whetif, fere is a 

forces w'hfh a gIZcfnwi ffneftf F °' ^ the “»*•“ 

fhe^nf f ° rCeS T generat6d by a ma «ipulator under position control when an obstacle prevents 

behind a If mue to C .° mmanded P “ ilit>n F ” if ‘ he lip b commanded to a position 

behind a wall (due to position sensor inaccuracies or an error in modeling the environment) the tin 

w," be stopped by the wall but continue to exert a force on it as the tip trii to reach fe commanded 

P “ '° n , h ' m ** n j U< ! e the resu| t |n g contact force depends on how far the commanded position 

- a m^7m'r^S: tei “ “ S "”' SS " ° f Th “ ba — 

F=-KAx, ( 12 ) 

Ifr/ IS ‘ h ' aClinS on lhe wal1 “ d A * ‘he d »‘«ce from the commanded position to the 

the resufifftf de«fti'on P ' eSSeS K ' 4li °" “ th ' * ip ia f '“ spa « a " d 

Any manipulator under position control exhibits such a stiffness due to position feedback in the 

n f wriuen - - CAe ’ c b tha ££*£ 

Jacobian J relates tT ^ ^7 7 ^ C ° ntro1 ^ eqUation 9 )- 11 is well-known that the 

Jacobin / relates tip deflections to joint deflections by JAG = Ax and tip forces to joint torques bv 

yields' SUbSt,tUtlng heSC re lations into the steady-state control law above and rearranging 


F = -(J5A'“ 1 5 T J r ) _1 Ax. 


(13) 


Thus the apparent stiffness matrix of the manipulator under modal control is A' = (JSK~ l S r J T )~ l 

™ e «i„ P lT‘^f hiS m * l ' iX “ 4 rU " Ctl °" ° f ‘ h ' ““'O''" gai “ “ d a "8'- » » t»Pi' of 
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Path Planning for a Redundant Manipulator 

The simplest problem in path planning is computing a tip-space position, velocity, and acceleration 
the end Sector from on. pent to another. A 5th-o,der »ph»e has been ctoen 
Z this pu, pose because it can gi.e z„o velocity and acceleration at the end points. The solution ,s 

x(t) = Xi + (6r 5 - 15r 4 + 10r 3 )(r/ - x,), ( 14) 

where x< and Xj are the initial and final positions and r (defined as t/T) is normalized time withT 
the total maneuver time [3], It can be shown that this spline also gives ^e m'mrnum jerh y 

polynomial trajectory. Hollars recommends that the controller have a bandwidth of at least 4/1 h 
L adequately track Lis spline. The same spline is used for all three tip-space coordinates. As a 
result the trajectory is a straight line between the start and end points. 

The next task in path planning is generating a joint-space trajectory corresponding to the _ desired 
tip space trajectorv. For redundant manipulators, there exists an infinite number of joint trajectories 
for ^Sory In the present case there is one redundant degree of freedom, therefore one 
additional constraint must be added in order to produce a solution. This constraint could arise from 
considerations of singularity avoidance, obstacle avoidance, tip-space stiffness, etc. 

The present manipulator has no internal singularities within the region of complete thbre^ion 
Therefore an easy singularity avoidance scheme consists of limiting the workspace to this r ^S _ 
T ^constraint still need! to be chosen to solve the inverse kinematics. The constraint *3 = 0 one 
simple possibility This leaves four possible solutions for the other joint angles (see Fig - )■ 

be selected based on how the link, „e ,o be Z, 

or “down”, etc.). This choice could be driven by constraints on the position of the elbow 

arising from obstacle avoidance concerns. 

Another possible constraint is minimizing joint velocities. This can be accomplished by reso^d-rate 

control in which a desired tip velocity trajectory is transformed int ° a ^ ^ 

Jacobian pseudo-inverse is used to find the instantaneous minimum joint velocity. The solution 

©(/) = (15) 

where Y(t) is the vector of tip-space coordinates and Jt is the Jacobian pseudo-inverse given by 
Jt = JT(JJT)- 1. This solution minimizes the 2-norm of the joint velocity vector at each point in 
the trajectory Several modifications to this method have been proposed in the literature [4,5]. ley 
generally attempt to optimize some other performance criterion or potential function. 

One argument for using equation 15 is that it helps avoid singularities because joint velocities tend 
L mcreLTnear them. However, this method causes the tip to follow the desired trajectory exactly, 
therefore if the trajectory passes close to a singularity then the minimum joint velocity solution 
can be arbitrarily forge. Wampler and Leifer [6] have proposed an interesting modification to this 
method which causes the tip to deviate from the desired trajectory when it approaches a singularity. 
In this way an upper bound on joint velocities can be maintained. 

For the present manipulator, limiting the workspace to the region of complete orbit ^ 

avoid all internal singularities. If the manipulator is required to move out of this re a ton then 3 
the recommended constraint because it will avoid orbit angle limits. If the tip is always in tins region 
then either 0 3 = 0 or equation 15 gives acceptable results for simple pick-and-place operations 
constraints involving obstacle avoidance, elbow joint position, or tip stiffness arise, the redu, 1 , . 

can be used to address them. 


Path Planning in the Presence of a Tip Payload 
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Simulation Results 

noLTltZT ? 118 * h imU,at j° ns of t! P ^ajectory following with and without a payload using the 
a Igorithm and two redundancy management schemes. The starting an H a A' 

T? *' V '‘ c " rdina " s >' s " m «f Figure 1 are (-0.8 1.0, 0.6 and 

^ po,; ts B« eo^cUn. 

updated every 0.25 see and the payload is assumed to be a point mass of 100 kg located afThe tip' 

Figure 4 shows the response with no payload using the 0 3 = 0 constraint. All closed- loop Dole 
requeneies are set to 2.4 rad/sec, which is the minimum required for a 10 sec slew In the first 

h nd^ d Ua, an dt C0m 7 nded t,P m ° ti0n ^ Sh ° Wn - Althou S h the actual tip motion lags slightly 

maneuver 6 Note that^theT’ “ l ° the deSired end P ° siti ° n at the end of ^ 

; / h h dlscrete « am updating causes jumps in the commanded joint toraues 

ce join ynamics are not modeled here, the commanded torque is equal to the applied torque In 

actual. ty, the dynamics of the joint motor will smooth these jumps while not degrading the tracking 

accuracy. Modeling joint dynamics is currently being researched [2], S 

Figure 5 shows the same simulation except that the pseudo-inverse is used to generate the joint 
rajectory^ Notice how attains a final angle of about 35° in order to defease tj aver 2 e 
ocity of the other three joints. Otherwise, the performance is the same as before Figured 
shows the simulation of Figure 4 except that a 100 kg payload has been added. Another simulation 
bowed that the maximum control torque with this payload and a maneuver time of 10 se"Ts about 
Nm. Therefore, using equation 16 and the fact that the previous simulations have maximum 
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Figure 4: Simulated Maneuver with 03 — 0 Constraint 

control torques of 3 Nm, the maneuver time was lengthened by a factor of 2 (= y/njz) to bring 
the maximum control torque back to 3 Nm. In additron, the closed- oop poles -re redded 
1.2 rad/sec to match the increase in maneuver time. The tracking performance is as good as that 

with no payload. 



Figure 5: Simulated Maneuver with Minimum Joint Velocity Constraint 


Conclusions 

The inverse kinematics solution, a modal position control algorithm, and path planning results for 
a 7 degree of freedom manipulator have been presented. After arbitrarily choosing the elbow roll 
an-de. the redundant degree of freedom, the inverse kinematics has four solutions. Each solution 
corresponds to a different orientation of the links in space. It is also shown that a locus of ip 
positions exists in which there are kinematic limitations on the orbit angle. 

\ computationally simple modal position control algorithm has been developed which guarantees 
a nearly constant closed-loop dynamic response throughout the workspace. The algorithm consists 
of diagonalizing the mass matrix into four modal inertias and computing feedback gains to conti o 
the modal coordinates. This controller is able to reject the disturbance arising from the unmodeled 
velocity-squared terms. If all closed-loop poles are assigned to the same location, the algoiithm 
can be implemented with very little computation. To further reduce the required computation, the 
modal gains are at discrete time intervals. An update frequency of every o° of either pitch angle 
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Figure 6: Simulated Maneuver with 100 kg Payload 


motion significantly reduces computation without degrading performance. 

For commanding manipulator movements, a 5th-order spline with sero velocity and acceleration at 

be' altr "St! T°‘,b “r SP “ e Pa, , h ’ Th ' fte<1 “ s «* closed-loop poles should 
■ . . . * h ^ re T 1S the tra Jectory duration, to maintain adequate tracking The best 

singularity avoidance scheme is keeping the tip trajectory in the region of complete orbif capability 
The orb.t angle can then be used to address other constraints such as obstacle avoidance or tip-space 
less. method is presented for modifying the trajectory duration when a payload is added to 
maintain a constant joint control torque. The payload should be modeled in the mass matrix to 
allow accurate control over the closed-loop bandwidth. 
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